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(5 の 【 要約 】 ( 修正 有 ) 

【 課題 】 ヒューマノイド ロボット 等 の ロボ ッ ト 制御 に お 
いて 、 断線 等 ト ルク セン サ の 異常 が 発生 し た 場合 で あっ 
て も 、 急 停止 し な いこ と に よっ て 安全 が 十分 に 確保 され 
、 機 器 に 対し て の 過大 な 付加 も 生じ ず 、 か つ 周 囲 の 者 に 
対し て 恐怖 感 を 抱か せ ず 安心 感 を 与え る こと の 可能 な 、 

モー タ 安全 停止 構造 を 提供 する こと 。 

【 解決 手段 】 モ ー タ 安全 停止 構造 1 0 0 は モー タ 9 の ト 
ルク 制御 異常 時 に お ける 安全 停止 構造 で あっ て 、 モ ー タ 
9 の ト ルク 制御 を 行う ト ルク 制御 系 2 0 と 、 ト ルク 制御 
系 2 0 と 並列 に 設け られ る 速度 制御 系 1 0 と 、 両 制御 系 
20、10 を 切り 替え る 切替 手段 3 0 と か ら な り 、 切 替 
手段 3 0 は 、 ト ルク 制御 異常 時 に ト ルク 制御 系 2 0 か ら 
速度 制御 系 1 0 に モー タ 制御 を 切り 替え る よう に 形成 さ 
れ て いる 構成 と する 。 

【 選択 図 】 図 1 
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【 特許 請求 の 範囲 】 

【 請求 項 1 】 

モー タ の トル ク 制 御 異常 時 に お ける 安全 停止 構造 で あっ て 、 モ ー タ の トル ク 制 御 を 行う ト 
ルク 制御 系 と 、 該 トル ク 制 御 系 と 並列 に 設け ら れる 速度 制御 系 と 、 両 制御 系 を 切り 替え る 
切替 手段 と か ら な り 、 該 切替 手段 は 、 ト ルク 制御 異常 時 に 該 ト ルク 制御 系 か ら 該 速度 制御 
系 に モー タ 制 御 を 切り 替え る よう に 形成 され て いる こと を 特徴 と する 、 モ ー タ 安全 停止 構 
造 。 

【 請求 項 2】 

前 記 速 度 制御 系 は 、 速度 指令 値 を 発する 速度 指令 手段 と 、 制 御 対象 で ある モー タ に 設置 さ 
れ た 位置 セン サ か ら の 位置 情報 に 基づき 実 速 度 を 算出 する 速度 算出 手段 と 、 該 速度 指令 値 
お よび 該 実 速度 に 基づき 該 速 度 指令 値 に 追従 する よう な 電流 指令 値 を 計算 する 速度 制御 器 
と 、 該 電流 指令 値 に 対し て 出力 電流 が モー タ 最 大 値 を 超え な いよ うに する 電流 リミッタ と 
、 電 流 検出 手段 と 、 該 電流 指令 値 お よび 該 電流 検出 手段 に より 検出 され た 電流 値 に 基づき 
該 電 流 指 令 値 に 対し て 追従 する よう な モー タ 印 加 電 圧 を 計算 する 電流 制御 器 と か ら 構 成 さ 
れ て いる こと を 特徴 と する 、 請 求 項 1 に 記載 の モー タ 安 全 停 止 構造 。 

【 請求 項 3 】 

前 記 ト ルク 制御 異常 は トル クセ ン サ の 断線 で ある こと を 特徴 と する 、 請 求 項 1 また は 2 に 
記載 の モー タ 安 全 停止 構造 。 

【 請求 項 4 】 

前 記 モ ー タ は ロボ ッ ト 用 で ある こと を 特徴 と する 、 請 求 項 1 な いし 3 の いずれ か に 記載 の 
モー タ 安 全 停止 構造 。 

【 請求 項 5 】 

前 記 ロ ボッ ト は ヒュ ー マ ノ イド ロボ ッ ト で ある こと を 特徴 と する 、 請 求 項 4 に 記載 の モー 
タ 安全 停止 構造 。 

【 請求 項 6 】 

トル ク 制 御 を 行う トル ク 制 御 系 と 、 該 トル ク 制 御 系 と 並列 に 設け ら れる 速度 制御 系 と 、 両 

制御 系 を 切り 替え る 切替 手段 と か ら な る モー タ 制 御 シ ステ ム で あっ て 、 通 常時 に は 該 ト ル 
ク 制御 系 に よる 制御 が な され て いる と 同時 に 該 速 度 制御 系 で は 制御 計算 が な され 、 ト ルク 

制御 異常 時 に は 該 ト ルク 制御 系 か ら 該 速度 制御 系 に 切り 替え られ て 制御 計算 に 基づく モー 
タ 制御 が な され る こと を 特徴 と する 、 モ ー タ 制御 シス テム 。 

【 請求 項 7 】 

前 記 速 度 制御 系 は 、 速度 指令 手段 と 、 実 速度 を 算出 する 速度 算出 手段 と 、 該 速度 指令 値 お 
よび 該 実 速度 に 基づき 該 速度 指令 値 に 追従 する よう な 電流 指令 値 を 計算 する 速度 制御 器 と 
電流 リミッタ と 、 電流 検 出 手段 と 、 該 電流 指令 値 お よび 該 電流 検出 手段 に より 検出 され 
た 電流 値 に 基づき 該 電 流 指令 値 に 対し て 追従 する よう な モー タ 印 加 電 圧 を 計算 する 電流 制 

御 器 と か ら 構 成 さ れ て いる こと を 特徴 と する 、 請 求 項 6 に 記載 の モー タ 制 御 シ ステ ム 。 
請求 項 8 】 

請求 項 6 また は 7 に 記載 の モー タ 制 御 シ ステ ム を 用 いた モー タ 制 御方 法 で あっ て 、 通 常時 
に は 前 記 ト ルク 制御 系 に よる 制御 が な され て いる と 同時 に 前 記 速 度 制御 系 で は 制御 計算 が 

な され 、 ト ルク 制御 異常 時 に は 該 ト ルク 制御 系 か ら 該 速度 制御 系 に 切り 替え られ て 制御 計 

算 に 基づく モー タ 制 御 が な され 、 こ れ に より トル ク 制 御 異常 時 に お ける 安全 な モー タ 停 止 
が 可能 で ある こと を 特徴 と する 、 モ ー タ 制御 方 法 。 

【 請求 項 9 】 

請求 項 6 また は 7 に 記載 の モー タ 制 御 シ ステ ム を 備え て いる こと を 特徴 と する 、 ロ ボッ ト 


と で 


請求 項 1 0 】 
請求 項 6 また は 7 に 記載 の モー タ 制 御 シ ステ ム を 備え て いる こと を 特徴 と する 、 ヒ ュー マ 
ノイ ドロ ボッ ト 。 


【 発明 の 詳細 な 説明 】 
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【 技術 分 野 】 
【0001]】 

本 発明 は モー タ 安 全 停 止 構 造 、 モ ー タ 制御 シス テム 、 モ ー タ 制御 方 法 お よび ヒュ ー マ ノ 
イド ロボ ッ ト に 係り 、 特 に 、 ヒ ュー マ ノ イ ドロ ボッ ト 等 で 使用 され て いる トル クセ ン サ が 
断線 し た 際 に 、 モ ー タ を 安全 に 停止 する た め の モ ー タ 安全 停止 構造 等 に 関す る も の で ある 
【 背景 技術 】 

[0002]】 

ヒュ ー マ ノ イド ロボ ッ ト の 制御 に お いて 、 ト ルク セン サ の アラ ー ム 停止 が 発生 し た 際 に 
は 、 通 常 、 位 置 制 御 に よっ て 急 停 止 を 行い 、 そ の 場 で 停 凸 する 。 ヒ ュー マ ノ イ ドロ ボッ ト 
の 制御 に つい て は 従来 、 技 術 的 な 提案 も な され て いる 。 た と えば 後 掲 特 許 文献 1 に は 、 超 
多 自由 度 の ヒュ ー マ ノ イド ロボ ッ ト の 診断 、 予 知 、 健 全 管理 に 有効 な 手法 と し て 、 次 の よ 
うな 技術 が 開示 され て いる 。 

【0003】 

すなわち 、 多重 高速 通信 ネッ トワ ー ク に 渡っ て 関節 お よび その 他 の 統合 シス テム 構成 要 
素 を 制御 する 分 散 コ ント ロー ラ 、 お よび 、 各 制御 レベ ル で ロボ ッ ト 内 に 組み 込ま れ て ネッ 
トワ ー ク に 渡っ て 各 制 御 レ ベル に 対し 診断 ・ 予 知 ・ 健全 管理 デー タ (DPHM デ ー タ ) を 
計測 ・ 制御 ・ 記 録 す る DPHM モ ジュ ー ル を 備え た シス テム で ある 。 こ れ に より 、 分 散 コ 
ント ロー ラ の 多重 制御 レベ ル 内 に 、 複 数 の DPHM モ ジュ ー ル を 組み 込み 、DPHM モ ジ 
ュー ル を 使用 し て 、 制 御 レ ベル の 各々 内 の DPHM デ ー タ を 計測 し 、 高 速 通信 ネッ トワ ー 
ク の 少な く と も 1 つ に 渡っ て アク セス 可能 な 位置 に DPHM デ ー タ を 記録 する こと で 、 ロ 
ボッ ト を 制御 する と し て いる 。 

【 先行 技術 文献 】 

【 特許 文献 】 

[0004]】 

【 特許 文献 1 】 特 開 2011-67942 号 公報 「 ヒ ュー マ ノ イ ドロ ボッ ト の た め の 診 は 
、 予 知 、 及 び 健 全 管 理 シ ステ ム 並 びに 方 法 」 

【 発明 の 概要 】 

【 発明 が 解決 し よう と する 課題 】 

[0005]】] 

さて 上 述 の と お り 、 ヒ ュー マ ノ イ ドロ ボッ ト の 制御 中 に トル クセ ン サ の アラ ー ム 停止 が 
発生 し た 場合 は 、 位 置 制御 に よる その 場 で の 急 停止 が な され る た め 、 機 器 に 対し て 過大 な 
負荷 が 掛か る 。 ま た 、 急 停止 と いう 急激 な 動作 は 周囲 の 者 に 対し て 急迫 の 危険 を 感じ させ 
、 恐怖 感 を 抱か せる 可能 性 が ある 。 実際 、 急 停止 の 制御 が な され な が ら 、 も し 何ら か の 原 
因 で 停止 すべ き 部 位 等 に 制動 が か か ら な か っ た 場合 に は 、 大 変 に 危険 な 事態 と な る 。 
【0006】 

し た が っ て 、 ヒ ュー マ ノ イ ドロ ボッ ト 制 御 に お いて トル クセ ン サ の 異常 が 発生 し た 場合 
で あっ て も 、 安 全 が 十分 に 確保 され 、 機 器 に 対し て の 過大 な 付加 も 生じ ず 、 か つ 、 急 停止 
し な いこ と に よっ て 周囲 の 者 に 恐怖 感 を 抱か せ ず 安心 感 を 与え る こと の 可能 な 技術 が 求め 
られ て いる 。 か か る 課題 は ヒュ ユー マ ノ イ ドロ ボッ ト に 限定 され ず 、 広く ロ ボッ ト 全般 に お 
いて 共通 する も の で ある 。 

【0007]】 

そこ で 本 発明 が 解決 し よう と する 課題 は 、 か か る 従来 技術 の 問題 点 を な くし 、 ヒ ュー マ 
ノイ ドロ ボッ ト 等 の ロボ ッ ト 制御 に お いて 、 断線 等 トル クセ ン サ の 異常 が 発生 し た 場合 で 
あっ て も 、 急 停止 し な いこ と に よっ て 安全 が 十分 に 確保 され 、 機 器 に 対し て の 過大 な 付加 
も 生じ ず 、 か つ 、 急 停止 し な いこ と に よっ て 周囲 の 者 に 対し て 恐怖 感 を 抱か せ ず 安心 感 を 
与え る こと の 可能 な 、 モ ー タ 安全 停止 構造 、 モ ー タ 制御 シス テム 等 を 提供 する こと で ある 
【 課題 を 解決 する た め の 手 段 】 

【0008】 
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本 願 発 明 者 は 上 記 課 題 に つい て 検討 し た 結果 、 ト ルク 制御 系 と は 別に 並列 処理 を 行っ て 
いる 速度 制御 系 を 、 普 段 は 使用 せ ず に 演算 だ け を 行っ て お き 、 ト ルク セン サ が 断線 し た 際 
に は 瞬時 に 速度 制御 系 に 切り 替え 、 設 定 し た 時 間 で 現在 速度 か ら O 速度 へ 速度 制御 を 継続 
し 、 安 全 に 停止 させ る よう に する こと に よっ て 解決 で きる こと を 見 出し 、 こ れ に 基づい て 
本 発明 を 完成 する に 至っ た 。 す な わ ち 、 上 記 課 題 を 解決 する た め の 手 段 と し て 本 願 で 特許 
請求 され る 発明 、 も し く は 少な く と も 開示 され る 発明 は 、 以 下 の 通 り で ある 。 
【0009】 

[ 1 ] モー タ の トル ク 制 御 異常 時 に お ける 安全 停止 構造 で あっ て 、 モ ー タ の トル ク 制 
御 を 行う トル ク 制 御 系 と 、 該 トル ク 制 御 系 と 並列 に 設け られ る 速度 制御 系 と 、 両 制御 系 を 
切り 替え る 切替 手段 と か ら な り 、 該 切替 手段 は 、 ト ルク 制御 異常 時 に 該 ト ルク 制御 系 か ら 
該 速 度 制御 系 に モー タ 制 御 を 切り 替え る よう に 形成 され て いる こと を 特徴 と する 、 モ ー タ 
安全 停止 構造 。 

[2〕] 前 記 速 度 制御 系 は 、 速 度 指令 値 を 発する 速度 指令 手段 と 、 制 御 対象 で ある モー 
タ に 設置 され た 位置 セン サ か ら の 位置 情報 に 基づき 実 速 度 を 算出 する 速度 算出 手段 と 、 該 
速度 指令 値 お よび 該 実 速度 に 基づき 該 速 度 指令 値 に 追従 する よう な 電流 指令 値 を 計算 する 
速度 制御 器 と 、 該 電流 指令 値 に 対し て 出力 電流 が モー タ 最 大 値 を 超え な いよ うに する 電流 
リミッタ と 、 電流 検 出 手段 と 、 該 電流 指令 値 お よび 該 電流 検出 手段 に より 検出 され た 電流 
値 に 基づき 該 電流 指令 値 に 対し て 追従 する よう な モー タ 印 加 電 圧 を 計算 する 電流 制御 器 と 
か ら 構 成 さ れ て いる こと を 特徴 と する 、〔 1 〕 に 記載 の モー タ 安 全 停止 構造 。 

[3〕] 前 記 ト ルク 制御 異常 は トル クセ ン サ の 断線 で ある こと を 特徴 と する 、[〔 1 ] ま 
た は 〔 2 〕 に 記載 の モー タ 安全 停 止 構造 。 

【0010]】 

[4〕 前 記 モ ー タ は ロボ ッ ト 用 で ある こと を 特徴 と する 、〔【 1〕 な いし [3 〕] の い ず 
れ か に 記載 の モー タ 安 全 停 止 構造 。 

[5〕 前 記 ロ ボッ ト は ヒュ ー マ ノ イド ロボ ッ ト で ある こと を 特徴 と する 、〔 4 〕] に 記 
載 の モー タ 安全 停 止 構造 。 

[ 61] ト ルク 制御 を 行う トル ク 制 御 系 と 、 該 トル ク 制 御 系 と 並列 に 設け られ る 速度 制 
御 系 と 、 両 制御 系 を 切り 替え る 切替 手段 と か ら な る モー タ 制 御 シ ステ ム で あっ て 、 通 常時 
に は 該 ト ルク 制御 系 に よる 制御 が な され て いる と 同時 に 該 速 度 制御 系 で は 制御 計算 が な さ 
れ 、 ト ルク 制御 異常 時 に は 該 ト ルク 制御 系 か ら 該 速度 制御 系 に 切り 替え られ て 制御 計算 に 
基づく モー タ 制 御 が な され る こと を 特徴 と する 、 モ ー タ 制御 シス テム 。 

【0011]】 

[7] 前 記 速 度 制御 系 は 、 速 度 指令 手段 と 、 実 速度 を 算出 する 速度 算出 手段 と 、 該 速 
度 指令 値 お よび 該 実 速度 に 基づき 該 速度 指令 値 に 追従 する よう な 電流 指令 値 を 計算 する 速 
度 制御 器 と 、 電 流 リ ミッ タ と 、 電流 検出 手段 と 、 該 電流 指令 値 お よび 該 電流 検出 手段 に よ 
り 検 出さ れ た 電流 値 に 基づき 該 電流 指令 値 に 対し て 追従 する よう な モー タ 印 加 電 圧 を 計算 
する 電流 制御 器 と か ら 構 成 さ れ て いる こと を 特徴 と する 、〔 6 〕 に 記載 の モー タ 制御 シス 
テム 。 

[ 8] [ 6〕 また は 〔 7] に 記載 の モー タ 制 御 シ ステ ム を 用 いた モー タ 制 御方 法 で あ 
っ て 、 通 常時 に は 前 記 ト ルク 制御 系 に よる 制御 が な され て いる と 同時 に 前 記 速 度 制御 系 で 
は 制御 計算 が な され 、 ト ルク 制御 異常 時 に は 該 ト ルク 制御 系 か ら 該 速度 制御 系 に 切り 替え 
られ て 制御 計算 に 基づく モー タ 制 御 が な され 、 こ れ に より トル ク 制 御 異 常時 に お ける 安全 
な モー タ 停 止 が 可能 で ある こと を 特徴 と する 、 モ ー タ 制御 方 法 。 

[ 9 ] [ 6 〕 また は 〔 7 〕 に 記載 の モー タ 制 御 シ ステ ム を 備え て いる こと を 特徴 と す 
る 、 ロ ボッ ト 。 

[10] [6〕 また は 〔7 ]〕 に 記載 の モー タ 制 御 シ ステ ム を 備え て いる こと を 特徴 と 
する 、 ヒ ュー マ ノ イ ドロ ボッ ト 。 

【 発明 の 効果 】 
[0012]】 
本 発明 の モー タ 安 全 停 止 構 造 、 モ ー タ 制御 シス テム 、 モ ー タ 制御 方 法 お よび ヒュ ー マ ノ 
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イド ロボ ッ ト は 上 述 の よう に 構成 され る た め 、 こ れ ら に よれ ば 、 ヒ ュー マ ノ イ ドロ ボッ ト 
等 の ロボ ッ ト 制御 に お いて 、 断線 等 トル クセ ン サ の 異常 が 発生 し た 場合 で あっ て も 、 急 停 
止 し な いこ と に よっ て 安全 が 十分 に 確保 され 、 機 器 に 対し て の 過大 な 付加 も 生じ ず 、 か つ 
周囲 の 者 に 対し て 恐怖 感 を 抱か せ ず 安心 感 を 与え る こと が で きる 。 

【[0013]】] 

本 発明 で は 、 断線 等 に より トル クセ ン サ の み に 異 常 が 発生 し た ケー ス を 想定 し て いる た 
め 、 モ ー タ の 位置 セン サ は 通常 どおり 動作 し て いる 。 し た が っ て 、 ト ルク 制御 系 と は 別 系 
統 で ある と ころ の 速度 制御 が な され 、 ア ラー ム 発 報 中 で あっ て も 緩やか な 自然 な 減速 停止 
が 行わ れ 、 あ る 程度 慣性 が 残っ た 状態 で 停止 させ られ る た め 、 安全 に ゆっ くり と 制御 を か 
け て 自然 な 停止 を 実現 する こと が で き 、 周 囲 の 者 に 怖 れ を 抱か せる こと が な い 。 
【0014]】 

な お 、 上 記 文 献 で 開示 され て いる 技術 は 、 高 速 ネ ットワーク を 通じ て ヒュ ー マ ノ イド ロ 
ボッ ト の 各 モ ジュ ー ル の エラ ー を 視覚 的 に 表示 する と いう も の で ある 。 し た が っ て 、 モ ジ 
ュー ル に て 何ら か の エラ ー が 発生 し た 時 に 、 モ ジュ ー ル の み で 独立 し て 安全 に 停止 する た 
め の 本 発明 と は 、 根 本 的 に 相違 する 。 

【 図面 の 簡単 な 説明 】 

0015】 

図 1 】 本 発明 の モー タ 安 全 停 止 構造 の 基本 構成 を 示す ブロ ッ ク 図 で ある 。 

発明 を 実施 する た め の 形 態 

0016】 

以下 、 図 面 に より 本 発明 を 詳細 に 説明 する 。 

図 1 は 、 本 発明 の モー タ 安 全 停 止 構造 の 基本 構成 を 示す ブロ ッ ク 図 で ある 。 図示 する よ 
うに 、 本 モー タ 安 全 停 止 構造 100 は モー タ 9 の トル ク 制 御 異常 時 に お ける 安全 停止 構造 
SARS モー タ 9 の トル ク 制 御 を 行う トル ク 制 御 系 2 0 と 、 ト ルク 制御 系 2 0 と 並列 に 

設け られ る 速度 制御 系 1 0 と 、 両 制御 系 20、1 0 を 切り 替え る 切替 手段 30 と か ら な り 
、 切 立 手 段 3 0 は 、 ト ルク 制御 異 堂 時 に トル ク 制 御 系 2 0 か ら 束 度 制御 系 1 0 に モー タ 制 
御 を 切り 替え る よう に 形成 され て いる こと を 、 主 た る 構成 と する 。 

【0017]】 

か か る 構成 に より 本 モー タ 安 全 停 止 構 造 1 0 0 で は 、 ト ルク 制御 系 2 0 に よる モー タ 9 
の 制御 と 速度 制御 系 1 0 に お ける 制御 演算 と が 並列 的 に 、 つ まり 同時 進行 で 行わ れ 、 通 常 
時 に は 切替 手段 30 は トル ク 制 御 系 2 0 に 接続 され て お り 、 し た が っ て トル クセ ン サ 8 か 
ら の 情報 に 基づき トル ク 制 御 器 23 に よる モー タ 制 御 が な され る が 、 ト ルク セン サ 8 に 断 
線 等 の 異常 が 発生 した 時 に は 、 切 替 手段 3 0 は トル ク 制 御 系 2 0 か ら 速 度 制御 系 1 0 に 切 
り 替 えら れ 、 モ ー タ 9 は 速度 制御 ・ 電流 制 御 に より 制御 され る 。 

【0018】 

上 述 の と お り 本 発明 で は 、 断線 等 に より トル クセ ン サ 8 の み に 異 常 が 発生 し た ケー ス を 
想定 し て いる た め 、 モ ー タ 9 の 位置 セン サ 7 は 通常 どおり 動作 し て いる 。 し た が っ て 、 ト 
ルク 制御 系 2 0 と は 別 系 統 で ある と ころ の 速度 制御 系 1 0 に よっ て 速度 制御 が な され 、 ア 
ラー ム 発 報 中 で あっ て も 、 モ ー タ 9 の 緩やか な 自然 な 減速 停止 が 行わ れ 、 あ る 程度 慣性 が 
残っ た 状態 で 停止 させ られ る 。 つ まり 、 安全 に ゆっ くり と 制御 を か け て 自然 に モー タ 9 を 
停止 させ る こと が で き 、 周 囲 の 者 に 怖 れ を 抱か せる こと が な い 。 

【0019】 

図示 する よう に 本 モー タ 安 全 停止 構造 1 0 0 の 速度 制御 系 1 0 は 、 速 度 指令 値 を 発する 

速度 指令 手段 11 と 、 制 御 対 象 で あや る モー タ 9 に 設置 され た 位置 セン サ 7 か ら の 位置 情報 
に 基づき 実 速 度 を 算出 する 速度 算出 手段 12 と 、 速 度 指令 値 お よび 実 速 度 に 基づき 速度 指 

令 値 に 追従 する よう な 電流 指令 値 を 計算 する 速度 制御 器 1 3 と 、 電 流 指 令 値 に 対し て 出力 
2 タ 最 大 値 を 超え な いよ うに する 電流 リミッタ 1 4 と 、 電 流 検 出 手段 15 と 、 電 
流 指令 値 お よび 電流 検出 手段 15 に より 検出 され た 電流 値 に 基づき 電流 指令 値 に 対し て 追 
EE タ 印 加 電 圧 を 計算 する 電流 制御 器 1 6 と か ら 構 成す る こと が で きる 。 
[0020]】] 
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速度 制御 器 1 3 は 、 速度 指令 手段 11 か ら 発 せら れ た 速度 指令 値 に 対し て 追従 する よう 

な 電流 指令 値 を 計算 する 制御 器 で ある 。 ま た 、 電流 リ ミッ タ 1 4 は 、 算 出さ れ た 電流 指令 
値 に 対し て 出力 電流 が モー タ 最 大 値 を 超え な いよ うに する リミッタ で あり 、 モ ー タ 破損 を 
防止 する 。 ま た 、 電流 制御 器 1 6 は 、 電 流 指令 値 に 対し て 追従 する よう な モー タ 印 加 電 圧 
を 計算 する 制御 器 で ある 。 

【0021】 
CAR タ 安 全 停止 構造 1 00 の 速度 制御 系 1 0 で は 、 速 度 指令 手段 1 1 
より 速度 指令 値 が 発せ られ 、 一 方 、 速度 算出 手段 12 に より 位置 セン サ 7 か ら の 位置 情 
報 に 基づき 実 速 度 が 算出 され 、 速度 制御 器 1 3 に お いて 速度 指令 値 お よび 実 速 度 に 基づき 
速度 指令 値 に 追従 する よう な 電流 指令 値 が 計算 され 、 電 流 リ ミッ タ 1 4 に より 電流 指令 値 
に 対し て 出力 電流 が モー タ 最 大 値 を 超え な いよ う リ ミッ タ が か けら れ 、 電流 検出 手段 1 5 
に より Rb 電流 リミッタ 1 4 を 経た 電流 指令 値 と に 基づい て 、 電流 制御 
上 6 に お いて 電流 指令 値 に 対し て 追従 する よう な モー タ 印 加 電 圧 が 計算 され 、 こ れ に よ 
り モ ー タ 9 が 制御 され る 。 
【0022】 

な お 速度 指令 手段 11 は 、 モ ー タ 9 の 速度 を 、 ト ルク セン サ 8 異常 発生 時 の 速度 か ら 開 
始 し て 徐々 に 減少 させ 、 最 終 的 に 0 と する よう に 速度 指令 値 を 発する よう に 構成 する こと 
が で きる 。 か か る 構成 に より 、 モ ー タ 9 の 緩やか な 自然 な 減速 停止 が 行わ れる た め 、 十 分 
安全 に 、 自 然 に モー タ 9 を 停止 させ る こと が で き 、 周 囲 の 者 に 怖 れ を 抱か せる こと が な い 


[0023] 

また 同時 に 、 電 流 リ ミッ タ 1 4 に お いて は リミッタ 値 を 徐々 に 減少 させ 、 ト ルク を 抜く 
よう な 動作 に な る よう に する こと も で きる 。 か か る 構成 に より 、 ト ルク リミッタ 潤 減 に よ 
る 自然 な 脱力 が 生じ 、 あ る 程度 慣性 が 残っ た 状態 で 停止 させ る こと が で きる た め 、 十 分 安 
全 に 、 自然 に モー タ 9 を 停止 させ る こと が で き 、 周 囲 の 者 に 怖 れ を 抱か せる こと が な い 。 
[0024]】 

本 発明 の モー タ 安 全 停 止 構造 100 は 、 ト ルク セン サ 異 常 発生 時 お いて も 急 停 止 せ ず 安 
全 に 停止 させ る 需要 の 存在 する モー タ 、 モ ー タ 用 途 に 限定 な く 適 用 する こと が で きる 。 た 
と えば 、 ヒ ュー マ ノ イ ドロ ボッ ト その 他 の ロボ ッ ト 用 の モー タ に お いて 、 本 発明 モー タ 安 
全 停 止 構造 1 00 は 利用 性 が 高い 。 

【0025】 

な お 本 発明 モー タ 安 全 停 止 構造 100 は 、 ト ルク 制御 系 2 0 、 速 度 制御 系 1 0 、 お よび 
切替 手段 30 と か ら な る モー タ 制 御 シ ステ ム と 捉え る こと も で きる 。 す な わ ち 、 通 常時 に 
は トル ク 制 御 系 2 0 に よる 制御 が な され て いる と 同時 に 速度 制御 系 1 0 で は 制御 計算 が な 
され 、 ト ルク 制御 異常 時 に は トル ク 制 御 系 2 0 か ら 速度 制御 系 1 0 に 切り 替え られ て 制御 
計算 に 基づく モー 9 れる モー タ 制 御 シ ステ ム で ある 。 ま た 、 速度 制御 系 1 0 は 
上 述 の 構成 と する こと が で きる 。 

【0026】 

また 、 当 該 モ ー タ 制御 シス テム 1 00 を 用 いて 、 通 常時 に は トル ク 制 御 系 20 に よる 制 
御 が な され て いる と 同時 に 速度 制御 系 で は 制御 計算 が な され 、 ト ルク 制御 異常 時 に は トル 
ク 制御 系 か ら 該 速度 制御 系 に 切り 替え られ て 制御 計算 に 基づく モー タ 制 御 が な され 、 こ れ 
に より トル ク 制 御 異常 時 に お ける 安全 な モー タ 停 止 を 行う モー タ 制 御方 法 も 、 本 発明 の 範 
囲 内 で ある 。 さ ら に 、 当 該 モ ー タ 制御 シス テム 100 を 備え る ヒュ ー マ ノ イド ロボ ッ ト 、 
その 他 の ロボ ッ ト 自体 も また 、 本 発明 の 範囲 内 で ある 。 

【 産業 上 の 利用 可能 性 】 
【0027】 

本 発明 の モー タ 安 全 停 止 構 造 、 モ ー タ 制御 シス テム 等 に よれ ば 、 ヒ ュー マ ノ イ ドロ ボッ 
ト 等 の ロボ ッ ト 制 御 に お いて 、 断線 等 トル クセ ン サ の 異常 が 発生 し た 場合 で あっ て も 、 急 
停止 し な いこ と に よっ て 安全 が 十分 に 確保 され 、 OD Ee 
つ 周 囲 の 者 に 対し て 恐怖 感 を 抱か せ ず 安心 感 を 与え る こと が で きる 。 し た が っ て 、 ロ ボッ 
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モー タ 分 野 、 お よび 関連 する 全 分 野 に お いて 、 産業 上 利用 性 が 高 
符号 の 説明 】 
0028】 
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